//
// Created by songyunqi123 on 2019/1/5.
//
#include <cstdlib>
#include <cstring>
#include <memory>
#include "base64.h"

static const uint8_t base64_table[65] =
        "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
static const uint8_t base64_url_table[65] =
        "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789-_";

static std::shared_ptr<uint8_t > base64_gen_encode(const void *src, size_t len,
                                         size_t *out_len,
                                         const uint8_t *table,
                                         int add_pad)
{
    std::shared_ptr<uint8_t > out;
    uint8_t *pos;
    const uint8_t *end, *in;
    size_t olen;
    int line_len;

    olen = len * 4 / 3 + 4; /* 3-byte blocks to 4-byte */
    if (add_pad)
        olen += olen / 72; /* line feeds */
    olen++; /* nul termination */
    if (olen < len)
        return NULL; /* integer overflow */
    out.reset(new uint8_t[olen]);
    if (out.get() == NULL)
        return NULL;

    end = ((uint8_t*)src) + len;
    in = ((uint8_t*)src);
    pos = out.get();
    line_len = 0;
    while (end - in >= 3) {
        *pos++ = table[(in[0] >> 2) & 0x3f];
        *pos++ = table[(((in[0] & 0x03) << 4) | (in[1] >> 4)) & 0x3f];
        *pos++ = table[(((in[1] & 0x0f) << 2) | (in[2] >> 6)) & 0x3f];
        *pos++ = table[in[2] & 0x3f];
        in += 3;
        line_len += 4;
        if (add_pad && line_len >= 72) {
            *pos++ = '\n';
            line_len = 0;
        }
    }

    if (end - in) {
        *pos++ = table[(in[0] >> 2) & 0x3f];
        if (end - in == 1) {
            *pos++ = table[((in[0] & 0x03) << 4) & 0x3f];
            if (add_pad)
                *pos++ = '=';
        } else {
            *pos++ = table[(((in[0] & 0x03) << 4) |
                            (in[1] >> 4)) & 0x3f];
            *pos++ = table[((in[1] & 0x0f) << 2) & 0x3f];
        }
        if (add_pad)
            *pos++ = '=';
        line_len += 4;
    }

    if (add_pad && line_len)
        *pos++ = '\n';

    *pos = '\0';
    if (out_len)
        *out_len = pos - out.get();
    return out;
}


static std::shared_ptr<uint8_t >base64_gen_decode(const void *src, size_t len,
                                         size_t *out_len,
                                         const uint8_t *table)
{
    std::shared_ptr<uint8_t > out;
    uint8_t dtable[256], *pos, block[4], tmp;
    size_t i, count, olen;
    int pad = 0;
    size_t extra_pad;

    memset(dtable, 0x80, 256);
    for (i = 0; i < sizeof(base64_table) - 1; i++)
        dtable[table[i]] = (uint8_t) i;
    dtable['='] = 0;

    count = 0;
    for (i = 0; i < len; i++) {
        if (dtable[((uint8_t*)src)[i]] != 0x80)
            count++;
    }

    if (count == 0)
        return NULL;
    extra_pad = (4 - count % 4) % 4;

    olen = (count + extra_pad) / 4 * 3;
    out.reset(new uint8_t[olen]);
    pos = out.get();
    if (out.get() == NULL)
        return NULL;

    count = 0;
    for (i = 0; i < len + extra_pad; i++) {
        uint8_t val;

        if (i >= len)
            val = '=';
        else
            val = ((uint8_t*)src)[i];
        tmp = dtable[val];
        if (tmp == 0x80)
            continue;

        if (val == '=')
            pad++;
        block[count] = tmp;
        count++;
        if (count == 4) {
            *pos++ = (block[0] << 2) | (block[1] >> 4);
            *pos++ = (block[1] << 4) | (block[2] >> 2);
            *pos++ = (block[2] << 6) | block[3];
            count = 0;
            if (pad) {
                if (pad == 1)
                    pos--;
                else if (pad == 2)
                    pos -= 2;
                else {
                    /* Invalid padding */
                    return NULL;
                }
                break;
            }
        }
    }

    *out_len = pos - out.get();
    return out;
}


/**
 * base64_encode - Base64 encode
 * @src: Data to be encoded
 * @len: Length of the data to be encoded
 * @out_len: Pointer to output length variable, or %NULL if not used
 * Returns: Allocated buffer of out_len bytes of encoded data,
 * or %NULL on failure
 *
 * Caller is responsible for freeing the returned buffer. Returned buffer is
 * nul terminated to make it easier to use as a C string. The nul terminator is
 * not included in out_len.
 */
std::shared_ptr<uint8_t > base64::base64_encode(const void *src, size_t len,
                              size_t *out_len)
{
    return base64_gen_encode(src, len, out_len, base64_table, 0);
}


std::shared_ptr<uint8_t > base64::base64_url_encode(const void *src, size_t len,
                                  size_t *out_len, int add_pad)
{
    return base64_gen_encode(src, len, out_len, base64_url_table, add_pad);
}


/**
 * base64_decode - Base64 decode
 * @src: Data to be decoded
 * @len: Length of the data to be decoded
 * @out_len: Pointer to output length variable
 * Returns: Allocated buffer of out_len bytes of decoded data,
 * or %NULL on failure
 *
 * Caller is responsible for freeing the returned buffer.
 */
std::shared_ptr<uint8_t > base64::base64_decode(const void *src, size_t len,
                              size_t *out_len)
{
    return base64_gen_decode(src, len, out_len, base64_table);
}


std::shared_ptr<uint8_t > base64::base64_url_decode(const void *src, size_t len,
                                  size_t *out_len)
{
    return base64_gen_decode(src, len, out_len, base64_url_table);
}
